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METHOD AND APPARATUS FOR MOBILE ROBOT MOTION 

CONTROL 



This is a continuation-in-part of international application number 
5 PCT/US97/15605, filed on September 5, 1997, which claims a priority of U.S. 
provisional application 60/025,406, filed on September 6, 1996. 

Field of the Invention 

The present invention relates generally to manned or unmanned 
1 0 omni-directional, normal-wheeled vehicles. More precisely, this invention involves a 
method and apparatus for controlling the motion of mobile base used as a vehicle. 

Background of the Invention 

Mobile bases with intended applications in robotics and industrial automation 
require a great deal of movement flexibility in order to be fully utilized. Current robot 
1 5 mobile bases often employ a "synchro-drive" mechanism— a complex set of gears and 
pulleys that constrains the wheels to steer and to translate simultaneously. Since 
steering and translation movement is fully decoupled in this system, "steering in 
place" is possible. (Contrast this maneuverability with that of a car.) While this 
allows a good deal of maneuverability, its mechanical complexity makes it difficult 
20 and expensive to manufacture. Additionally, this type of mobile base has limited 
movement due to its fixed orientation (i.e. its inability to rotate). 

In general, a rigid body constrained to move in a plane (i.e. a mobile base 
moving on the floor) has three degrees of freedom (DOFs) such as, movement in the x 
direction, movement in the y direction and rotation. Combining these three DOFs 
25 results in movement in any direction while simultaneously rotating. 

A holonomic mobile base, has the ability move in this manner and change its 
motion at any time. By constructing a mobile base out of wheels that each have two 
degrees of freedom (one for steering, one for translation) all three DOFs are possible 
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under the proper control, and complex mechanisms found in synchro-drive mobile 
bases are no longer needed. Additionally, these 2-DOF wheels (2-DOFWs) can be 
easily integrated and manufactured as modular wheel assemblies. A complete 
description of one example of a robot base and modular wheel assembly is provided 
5 by U.S. Patent Application 09/134,241, by Holmberg et al., incorporated herein by 
reference. 

It is also possible to increase the "caster" of a 2-DOF W by moving the 
translation axis behind the steering axis (Figure 1) and making it resemble a caster 
wheel. Unlike a 2-DOFW wheel with no caster (i.e. intersecting steering and 

1 0 translation axes), a mobile base constructed with caster 2-DOFWs is fully holonomic 
under the proper control. 

Various problems arise, however, when trying to control a mobile base 
constrained to three DOFs with more than three controllable DOFs (e.g. a base with 
four 2-DOFWs has eight DOFs). A base with this many DOFs under improper 

1 5 control will certainly result in undesired motion and motor axes that "fight" each 
other, (i.e. consider two wheels facing opposite directions playing tug-of-war.) 

This in turn creates wheel slippage, increased tire wear, increased power 
consumption, and more frequent mechanical problems. 

It is considered important in robotics to be able to accurately assess the motion 

20 of the mobile base either through direct measurement or through estimation. This 
motion estimation can also be "summed-up" over time to create a "dead reckoned" 
position estimate of the mobile base with respect to fixed coordinates, which is also 
useful for autonomous tasks such as navigation. That is, consider a robot that wishes 
to navigate to a location (room) of which it knows the x-y coordinates. Motion 

25 estimation is also responsible for proper control of the mobile base, as will be 
described below. A control algorithm which minimizes wheel slippage will also 
allow for maximum motion estimation accuracy. 

Summary of the Invention 

The present invention overcomes the deficiencies in the prior art described 
30 above, and provides motion control for a mobile robot base that is more accurate and 
more maneuverable Referring to Figure 3 and the Detailed Description of the 



Preferred Embodiments, an overview of the inventive control sequence is provided in 
the following paragraph. 

A supervisory controller reads the input vector from a host processor, and 
maps the input vector to the desired axis motion vector (i.e. the desired motion of each 
5 axis) by using the equations in Section 2 below. It then predicts if the axes are 

capable of the desired motion by calculating their control envelopes (i.e. the motion 
possible within one control cycle At .) as described in Section 3. If all axes are 
capable of the desired motion within one control cycle the desired axis motion vector 
is passed to the low-level controller. If one or more axes are incapable of the desired 

10 motion,, a modified axis motion vector is calculated as described in Section 4 and 
passed to the low-level controller. The modified axis motion vector lies within the 
control envelopes of all 2N axes while minimizing control error (i.e. the difference 
between the commanded input vector and the actual base motion.) The control 
algorithm then estimates the motion of the mobile base since the last control cycle 

15 using the technique described in Section 5. The estimated motion is then used to 

update the position and orientation [x B 9 y B , ys B ] T of the base coordinate frame in the 
fixed world coordinate frame as described also in Section 5. The updated position and 
orientation is then made available for the host processor to read. The control 
algorithm then repeats the whole process by beginning another control cycle. 

20 Brief Description of the Drawings 

Figure 1 A is a perspective view showing a mobile base wheel with no caster 

offset. 

Figure IB is a perspective view showing a mobile base wheel with a caster 

25 offset. 

Figure 2 is a schematic diagram showing the flow of command information 
which controls the motion of the mobile base. 

Figure 3 is a schematic diagram showing the steps of a method for controlling 
the motion of the mobile base. 
30 Figure 4 is a perspective view schematically showing the layout of the mobile 

base wheels and the base and world coordinate systems. 
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Detailed Description of the Preferred Embodiments 

Section 1 - Overview of the Control Algorithm 

Referring to Table 1, a description of notations and variables used herein is provided. 

5 Table 1 

N Number of wheels 

[x m , y m f Cartesian position of wheel attachment point of 2- 

DOFW i to the base in base coordinates (m, m) 

[x' m , y' m J Cartesian position of wheel attachment point of 2- 

10 DOFW i to the base in base coordinates as it has 

changed since the previous control cycle using the 
coordinates of the previous control cycle (m, m) 
Q mWi Measured steer angle of 2-DOFW i (rad) 

0 mi Desired steer angle of 2-DOFW i (rad) 

15 m d Input vector (IV), or desired mobile base motion in base 

coordinates read from host processor (m/s, m/s, rad/s), 
(mis 1 , m/s 2 , rad/s 2 ), or (N, N, Nm) dependant on desired 
implementation 

fn x = [x, y, y/J Actual mobile base motion in base coordinates 

20 (m/s, m/s, rad/s) 

fft e = [x e y e ,W^l Estimated mobile base motion in base coordinates 

calculated as described in Section 5 (m/s, m/s, rad/s) 

Am e = [Ax e , Ay e , A y/ e J Estimated change in mobile base position in base 

coordinates calculated as described in Section 5 (m, m, 
25 rad) 

fh t (A) Possible mobile base motion decomposed along 

parametric line with parameter X (m/s, m/s, rad/s) 
(Section 4) 

m m Modified mobile base motion (m/s, m/s, rad/s) 

30 in a Axis motion vector (AMV) of length 2N. (Type of 

wheel (caster or no caster) and type of low level 

controller determines units) 
5 Small increment much less than 1 .0 (0. 1 nominal) 

(Section 4) 

3 5 [x^ , y mi J Desired velocity vector of attachment point of 2-DOFW 

i to the base in base coordinates (m/s, m/s) 
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10 



15 



20 



25 



30 



35 



40 



J mWi 



4: 



Wi 



As, 



mWi 



J max Wi 



3 lWi 



l mWi 



At, 



mWi 



l lWi 



l uWi 



Desired velocity magnitude of 2-DOFW i (m/s) 
Desired steering axis position for 2-DOFW i (encoders) 

Measured steering axis position for 2-DOFW i 
(encoders) 

Measured steering axis position for 2-DOFW i in the 

previous control cycle (encoders) 

Measured change in steering axis position for 2-DOFW 

i since the previous control cycle (m) 

Desired steering axis velocity for 2-DOFW i 

(encoders/s) 

Measured steering axis velocity for 2-DOFW i 
(encoders/s) 

Maximum steering axis velocity for 2-DOFW i 
(encoders/s) 

Maximum steering axis acceleration for 2-DOFW i 
(encoders/s 2 ) 

Lower-bound steering axis position for 2-DOFW / 
within A* time (encoders) 

Upper-bound steering axis position for 2-DOFW / 
within Artime (encoders) 

Lower-bound steering axis velocity for 2-DOFW i 

within A^time (encoders/s) 

Upper bound steering axis velocity for 2-DOFW i 

within Af time (encoders/s) 

Measured translation axis position for 2-DOFW / 

(encoders) 

Measured translation axis position for 2-DOFW i in the 

previous control cycle (encoders) 

Measured change in translation axis position for 2- 

DOFW i since the previous control cycle (m) 

Desired translation axis velocity for 2-DOFW i 

(encoders/s) 

Measured translation axis velocity for 2-DOFW i 
(encoders/s) 

Maximum translation axis velocity for 2-DOFW i 
(encoders/s) 

Maximum translation axis acceleration for 2-DOFW i 
(encoders/s 2 ) 

Lower-bound translation axis velocity for 2-DOFW / 
within Artime (encoders/s) 

Upper-bound translation axis velocity for 2-DOFW / 
within Artime (encoders/s) 
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r m Radius of 2-DOF W i (m) 

<j Wi Steering axis encoder pitch for 2-DOFW / 

(encoders/rad) 

r Wl Translation axis encoder pitch for 2-DOFW i 

5 (encoders/rad) 

c Wt Amount of caster for 2-DOFW i (m) 

At Time elapsed during a control cycle (s) 

[ x eB 9 y e B > VeB J Estimated position and orientation of the base 

coordinate frame (i.e. coordinates that are fixed with 
1 0 respect to the mobile base and move with the mobile 

base) in fixed world coordinates (i.e. coordinates that 
are fixed with respect to the floor on which the mobile 
base moves) (m 5 m, rad) 
C Constraint matrix which maps mobile base motion to 

15 axis speeds [2N x 3] 

C* The Force Projection Matrix which is the particular 

generalized inverse of the C matrix which is used to 
map the desired motion vector to the actuator control 
torques [3 x 2N] 

20 C* The Velocity Estimation Matrix which is the particular 

generalized inverse of the C matrix which is used to 
map actuator speeds to base speeds [3 x 2N] 

A The base mass matrix [3x3] 

ju The base centripetal, coriolis, and gravity vector [3x1] 

25 Yavi Desired steering axis torque for 2-DOFW i (N m) 

y m Lower-bound steering axis torque for 2-DOFW i (Nm) 

y uWi Upper-bound steering axis torque for 2-DOFW i (Nm) 

p mi Desired translation axis torque for 2-DOFW i (N m) 

p lWi Lower-bound translation axis torque for 2-DOFW i 

30 (Nm) 

p uWl Upper-bound translation axis torque for 2-DOFW i 

(Nm) 



35 Referring to Figures 1 A and IB, a mobile base constructed according to the 

present invention includes as many two degrees of freedom wheels (2-DOFWs) as 
deemed necessary (N>2, where N is the number of 2-DOFWs). All of the wheels 
are mounted on the mobile base which is a rigid platform (depicted in Figure 4.). 
Each 2-DOFW has two independent axes, one for steering and one for translation. 
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Figure 1 A shows an example of a 2-DOFW with no caster, i.e. c Wi = 0, such that the 
steering and translation axes intersect. Figure IB shows an example of a 2-DOFW 
having a caster offset, i.e. c m & 0 . In other words, the steering axis is offset from the 
translation axis by c Wi . Each of the 2-DOFWs on the mobile base can have a different 
5 amount of caster if necessary. 

Referring to Figure 2, a schematic diagram shows the flow of command 
information which controls the motion of the mobile base. Since each of the N wheels 
has two axes (i.e. steering and translation), the mobile base has a total of 2N axes. 
Controlling the 2N axes of the mobile base are 2N servo amplifiers connected to a set 

10 of low-level controllers that perform closed-loop, high servo-rate control of all axis 
positions. Positional feedback of each axis is provided by an accurate encoding 
scheme. A supervisory controller interfaced to the low-level controllers coordinates 
all 2N axes by sending position updates to the low-level controllers at each discrete 
control cycle. The position updates are calculated by the control algorithm which 

15 takes into account the mobile base geometry, motor dynamics, and a 3-DOF input 

vector sent from a host processor interfaced to the supervisory controller. The 3-DOF 
input vector completely describes the desired velocity-based motion of the mobile 
base, which is constrained to move within three DOFs as described previously. A 
possible input vector, for example, consists of an x-velocity, y-velocity, and rotational 

20 velocity with respect to the center of the mobile base, or alternatively, angle, 
magnitude, and rotational velocity with respect to a random fixed point (i.e. the 
representation is arbitrary as long as the axes of the input vector are independent.) 

The control algorithm is optimal in that it controls the 2N axes such that the 
mobile base moves as commanded by the input vector as accurately and as quickly as 

25 possible within the physical limits of the motors. 

For example, if a motor is commanded beyond what it is physically capable of 
(i.e. it is commanded beyond its "saturation point") while other motors are 
commanded to within their physical limits, wheel slippage occurs. The control 
algorithm is able to predict this situation and correct it before it occurs. It 

30 accomplishes this by anticipating velocity or torque and saturation points with 
working models of each motor axis. Thus, the control algorithm simultaneously 
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minimizes wheel slippage and minimizes the difference between desired motion 
specified by the input vector and actual mobile base motion (motion error). 



Section 2 - Mapping the Input Vector to the Desired Axis Motion Vector 

This determines the axis motion vector (AMV) ? fh a 9 which is the motion 
5 required at each 2-DOFW and the corresponding motion at each axis such that the 
mobile base moves according to the commanded input vector (i.e. [x d ^y d ^ d J )• 

Thus, the mapping is from 9? 3 to 9l 2N , It is accomplished by first calculating the 
desired velocity to each wheel attachment point as below. The desired wheel velocity 

for each wheel is expressed as a 2-vector [x^ , y mt ] r in base coordinates (Figure 4). 

10 (Vz: l<z<AO (i.e. for all wheels i): 

y<m 

where the [x Wi , y m J are the Cartesian coordinates of the wheel attachment point of 
each 2-DOFW i to the base in base coordinates (m, m). 
1 5 The steering angle ( ff mWl ) for each 2-DOFW is measured based on the raw 

measured encoder value of the steering axis ( s mWj ) and the encoder pitch ( a Wl ): 

s n 



mm 



and will be used in many of the following calculations. 

These desired wheel velocities are then mapped to the two axes of the 2- 
20 DOFW. For 2-DOFWs with no caster (c Wj = 0 ) the desired steering axis position and 

desired translation axis velocity [s^, are calculated for each 2-DOFW as 
follows: 

e mi =arctan2(>^ /? x^) 



F2 ~ 

MdWi ~ V X dWi + ydWi 



25 — <J Wl 6 mi 



t dWi ~ MdWi 
r Wi 

with 



m a = \. S dWl 9 t<m\ 3 • * S dWi ? ' * * " 5 ^rfffW ' ^fffW ] 

where 

6^, is the desired steering angle for 2-DOFW /, 

<j m is the steering axis "encoder pitch" for 2-DOFW i expressed in encoders per 
5 radian, and 

jUjjr, is the desired velocity magnitude for wheel i 

When using a velocity based low level controller for 2-DOFWs with caster 
(c m ^ 0) the desired steering axis velocity and desired translation axis velocity 
10 [i^ j^] are calculated for each 2-DOFW as below. 



S dWi ~ ' 



C Wt 



with 

1 5 where 

c m is the amount of caster offset in meters, 

r m is the encoder pitch for 2DOFW ; expressed in encoders per radians, and 
r m is the radius of the 2DOFW i 

When using a torque based low level controller for 2-DOFWs with caster 
20 (c m * 0 ) the desired steering axis torque and desired translation axis torque 

\/cWs 9 Pdwi Y ^ Q calculated for each 2-DOFW as below. First, gather coefficients of 
the base velocities from the previous equations used in the development of the 
velocity controller into the constraint matrix, C . The constraint matrix is defined by 
the ideal kinematic relationship: 
25 m a — Cm x 

where m a is the motion axis vector and m x is the actual mobile base motion. The 
constraint matrix for the preferred embodiment is: 



-9- 



- sin(0 mfn ) 








-!O-cos(0 mPn ) 


-K-sin(0 Mfri ) 


1 




- — sm(0 mW ) 


cos(6» mH ,,) 




p 












^cos(0 m(W ) 






^cos(^) 


^sin(0^) 







- (x wl cos(0 mWl ) + y wl sin(9 mW1 )) - 1 



^-(x m sm(0 mWl )-y wl cos(0 mW1 )) 
i 

- (x m cos(0 mWi ) + y m sin(0 mfr , )) - 1 



^-(x m sm(0 mWl ) - y m cos(0 mWi )) 



'wi 



( XwN cos(d mWN ) + y m sm(0 mW N )) - 1 



r WN 

Calculate, C* , the force projection matrix, a generalized left inverse of C . 
Any generalized left inverse will work. By judicious choice of a particular C* f 
various behaviors can be implemented. An example which is particularly useful is: 

5 c*=(c T cyc T 

which minimizes, in a least squares way, the axis torques. The axis motion vector 
containing the desired steering axis torque and desired translation axis torque 

l/jmiPdmY istnen: 
m a - C n /m d 

1 0 where m d is the 3-DOF force torque input vector. For control of a base with a known 
dynamic model, one can dynamically decouple the undesired forces by calculating the 
axis torques with the following expression: 

m a =cf {Am d +{i) 
where fh d is the 3 DOF acceleration input vector and 

15 fh a = \y dwl ,P df yi,---,yjw,>PdWi>-">ydWN>PdWN] 

are the axis torques. 

When controlling the base in 3 DOF it is desirable to eliminate or greatly reduce the 
undesired motion of the vehicle due to the dynamic effects of the various motions of 
the 2-DOFWs. This can be accomplished by using A and ju in the above equations as 
20 found from the dynamic model of the base. It is well understood by those skilled in 
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the art that the dynamic model, that is defined by the dynamic equations of a system 
(base) can be found and written as: 
F = Ax + /j 

where F is the 3 DOF linear and rotational force on the base, A is the mass matrix, 
5 x is the acceleration of the base in 3DOF, and ju is the centripetal, coriolis, and 
gravity vector. It is possible to control a base with unknown dynamics by using an 
estimate of the dynamic parameters such as: 





"1 


0 


0" 




"0" 


A = 


0 


1 


0 


, M = 


0 




0 


0 


1 




0 



but the base will not produce the desired motion as closely as when the values of the 
10 dynamic parameters for the actual base are used. 

Thus, by concatenating all N wheel motion pairs described above, we create a 
desired axis motion vector which is 2N in length. 

Section 3 - Calculating the Control Envelopes 

The control envelope for an axis describes the possible motion an axis can 
1 5 perform within a fixed time. For a 2-DOF W i with no caster ( c Wi = 0 ) we must 
calculate the steering axis position lower and upper bounds (s lm and s uWi ) and the 
translation axis velocity lower and upper bounds {t m and i uWi ). First, calculating the 
steering position lower bound, we assume that the axis should move based on a value 
proportional to the error (s mi - s mWl ) scaled by gain value ( k p ) minus a small 

20 tolerance ( e s ) or based on the maximum (negative) acceleration possible for the 

steering axis (s nsxm ) (the measured position and velocity ( s mm and s mWi ) are required 
to calculate the position as a result of maximum acceleration), whichever is greater: 

S lWt = maX i S mWi + ( S dWi ~ S mWi) ~ e s? S mWi + ^mWi^ _ "2 ^maxFFr^ ) 

Calculating the upper bound, we similarly assume the axis should move based 
25 on a value proportional to the error scaled by a gain value plus a small tolerance or 
based on the maximum (positive) acceleration, whichever is lesser. 

S uWi * m ^ n ( S mWi + kp( S <Wi ~~ S mWi ) + 6 s> S mWi ^mWi^ + !^max07^ ) 
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Calculating the lower bound of the translation axis velocity, we assume the 
control envelope is determined by either maximum (negative) acceleration, or by the 
maximum possible (negative) velocity of the translation axis (i maxWi \ whichever is 
greater. 

Calculating the upper bound, we similarly assume the control envelope is 
determined by either the maximum (positive) acceleration, or by the maximum 
possible (positive) velocity of the translation axis, whichever is lesser. 

Once these values have been determined, the desired motion [s^-, ] lies 
within the control envelope for At time duration if and only if 

S dWi — S lWi ail d Sjjpf < S mWi 

or 

1 5 S dWi — S uWi an( ^ S dWi — S mWi 



10 



For a 2-DOFW i with caster (c W{ ^ 0 ), when a velocity based low level 
controller is used, we must calculate the steering axis velocity lower and upper bounds 
20 ( s m and s uWi ) and translation axis velocity lower and upper bounds ( i lWi and i uWi ). 
Calculating the lower bound of the steering axis velocity, we assume the control 
envelope is determined by either maximum (negative) acceleration (S maxr; ), or by the 
maximum possible (negative) velocity of the translation axis (£ maxW7 ), whichever is 
greater. 

25 s lWi = max(s mm — s maxWl At 7 — s maxWl ) 

Calculating the upper bound, we similarly assume the control envelope is 
determined by either the maximum (positive) acceleration, or by the maximum 
possible (positive) velocity of the steering axis, whichever is lesser. 

30 
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Calculating the translation velocity lower and upper bounds is the same for 2- 
DOFWs with caster. 

5 

Once these values have been determined, the desired motion [s^, /^,] lies 
within the control envelope for At time duration if and only if 

s 1Wl < s mi < s uWl 

and 

1 0 t m < t mi < t uWj 

For a 2-DOF W i with caster ( c m ^ 0 ), when a torque based low level 
controller is used, we must determine if the motion input vector ( m d ) is within the 
upper bound of the actuator torque ( y uWl , p uWi ) and the lower bound of the actuator 
15 torque (y lWl ,p im ): 

YlWi — YdWi — YuWi 
PlWi — PdWt ~ PuWi 



Thus we can determine for a given increment in time ( At ) the possible motion 
20 for each axis (control envelope) of each 2-DOFW, and for a given axis motion vector, 
whether it lies within the control envelopes. 

Section 4 - Calculating the Modified Axis Motion Vector 

We describe an algorithm that can be applied when the desired axis motion 
vector mapped from the input vector does not lie within the control envelopes of all 
25 axes. Given a desired base motion input vector (m d ) and a current estimated base 
motion vector (m e ) (calculated in Section 5) we can determine a modified motion 
vector that is closest to the desired input vector while staying within the control 
envelopes of all axes. 
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When a velocity based low level controller is used, we begin by defining a 
parametric line m^X) as a function of X , which varies between 0 and 1 : 
m l (X) = X(m d -m e ) + m e 
0< X<\ 

5 Evaluating m ; (0) results in m e , which is the current base motion vector. 

Evaluating results in m d , which is the desired input vector. Thus, we define an 

algorithm that finds a value of X whose m^X) mapping is closest to the desired input 

vector and lies within the control envelopes when mapped to the axis motion vector. 

The basic idea is to increment X by a small amount (S) until the mapping of m^X) 
10 to the axis motion vector lies within the control envelopes. This becomes the 

modified axis motion vector. 

When a torque based low level controller is used, we again begin by defining 

a parametric line m l (X) as a function of X , which varies between 0 and 1 , where 

now: 

15 m l (X)^Xfh d 
0<X<1 

Evaluating m^O) results in zero torque command such that the base continues 
its current base motion vector. Evaluating m^l) results in fh d , which is the desired 
input vector. Thus, we define an algorithm that finds a value of X whose m^X) 
20 mapping is closest to the desired input vector and lies within the control envelopes 
when mapped to the axis motion vector. The basic idea is to increment X by a small 
amount (S) until the mapping of m t (X) to the axis motion vector lies within the 
control envelopes. This becomes the modified axis motion vector. 

25 Using: the appropriate equation for m^X) from above, and with 0 < S « 1 : 
begin procedure 
X = S 

while fhtiX) mapped to axis motion vector (Section 2) lies within 
control envelopes of all axes of each 2-DOFW (Section 3) do 

30 X = X + S 

end 
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return axis motion vector mapping of m m 

end 

5 Note, there are many possible ways to implement the same algorithm. This 

method is presented because of its simplicity. 

Section 5 - Estimating the Motion of the Mobile Base 

Here, we describe how to estimate the motion of the base during the discrete 
time interval At . First, we calculate the new apparent wheel positions with respect to 
10 the base coordinates. These new coordinates are expressed as x f m and y f m for wheel i. 
For wheels with no caster (c m - 0 ), we begin by calculating the measured steering 
angle as in Section 1 : 



We proceed by calculating the measured translation distance ( At mWl ) since the 
15 beginning of the previous control cycle: 

Here, we introduce \ Wi which is the measured translation axis position at the 
beginning of the previous control cycle expressed in encoders. The apparent wheel 
positions are then simply the wheel positions in base coordinates (x m and y Wi ) plus 
20 the calculated motion: 



x' m = x Wi + At mWl ^cos(0 mm ) 

Y 

y'm = yw, + temwt — sin(0 Mlw ) 



For wheels with caster (c m * 0 ), we similarly calculate the steering angle, 
25 6 mWl , and the apparent wheel motion as a result of the translation axis, At mWj . 
However, because of the caster offset, steering motion results in apparent wheel 
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motion as well. Here we introduce \ Wj which is the measured steering axis position 
at the beginning of the previous control cycle expressed in encoders: 

^mWi ~ ( S mWi ~ S mWi) 

The apparent wheel motion is then calculated by a rotation with respect to the steer 
5 angle: 

x 'm = *m + Mmm — ^s(9 mWl ) - As mWi -^sin(^) 

C V 

y'm = yw l + As m m — cos (&mWt ) + At m m — &n@mwt ) 

We then use the apparent wheel motion to calculate the amount of base rotation 
10 Ay/ e since the last control cycle. We do this by calculating the rotation for each 
possible wheel pair and averaging the results: 

M=C(N,2) 

A We=il X arctan2 ( y f m - y' Wj , x' wk - x' Wj ) - arctan2 {y wk - y Wj 9 x Wk - x WJ ) 

1 5 The above equation is summed over all possible wheel pairs j, k . That is, 

there are C(N,2) (N choose 2 combinatorial) possible wheel combinations. 

Since the position of a mobile base having only two wheels (i.e. N = 2) can be 
estimated with feedback from only three of its four motion axes (the fourth one being 
20 redundant), there are many other ways to estimate the motion of the base. The 

preceding formula can be used for bases having only two wheels, but there will only 
be one wheel pair to "average." As the number of wheels used on a mobile base goes 
up (i.e. as N increases), the better the above estimation algorithm gets. 

25 We now calculate the change in x and y coordinates ( Ax e and Ay e ) by 

evaluating the following equations: 

N 
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1=1 

The estimated base motion vector can be calculated by dividing by the time increment 
At: 

A similar method to calculate fh e , which directly averages the measured 
readings with a more compact notation, uses the matrix, C , introduced above: 

™e ~ ~}jC x \&S mm , && m w\ •> • • • 9 &$mWi > ^ mWi > • • • ? ^ mWN > ^ mXVN ] 

where C* , the velocity estimation matrix, is a generalized left inverse of C . Any 

1 0 generalized left inverse will work. By judicious choice of a particular C * various 
behaviors can be implemented. An example which is particularly useful is: 

ct={c T cYc T 

which minimizes, in a least squares way, the difference in the measured motion of the 
axis sensors and the motion of axis sensors on an ideal model of the PCV which 

15 perfectly obeys the velocity relationship described by C . 

The final step in motion estimation is determining the "summed-up" position 
of the mobile base in fixed world coordinates. This is accomplished by adding the 
rotation angle change Ay/ e to the existing angle estimate( y/ eB ). Similarly x eS and 
y eB are calculated by adding to the existing estimates the rotated change in x and y 

20 coordinates with respect to y/ eB : 

VeB=WeB+ A ¥e 

X eB = X eB + C0 KWeB ) " A> 'e ^H^eB ) 

y eB = y eS + AVe ™$(i// eB ) + Ax e sin(y/ eB ) 

Section 6 - Summary 

The present invention, as described above, provides a method and apparatus 
for controlling the motion of a mobile base with increased accuracy and 
25 maneuverability. In its preferred embodiment, the present invention is used on a 
mobile robot base having three wheels each with a predetermined amount of caster. 
The mobile robot is controlled by an off-board host processor (as shown in Figure 2.) 
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The host processor sends command signals and receives motion feedback from an 
onboard supervisory controller by radio, cable, infrared, or similar type of link. The 
motion control signals are mapped to axis control signals by the supervisory controller 
and sent to six low-level controllers. Each of the six low level controllers corresponds 
5 to either a steering axis or translation axis for one of the three wheels. Each of the low 
level controllers in turn sends an axis control signal to an associated servo amplifier, 
which provides the proper voltage and current to drive the respective axis motor. 
Each of the six motors has an encoder, which provides motor position feedback to 
both the low-level controller and the supervisory controller. 

10 The host processor and supervisory controller are preferably microprocessors 

that are commonly used for embedded control. Propriety software code is written 
preferably in C programming language to implement the inventive control method on 
the microprocessors and low level controllers. 

The inventive method and apparatus can be utilized with other configurations 

1 5 (not shown), such as on drive systems for forklifts or automated guided vehicles 

(AGV's.) Also, the mobile base described above can be inverted with the positions of 
the mobile base and the surface it rolls on transposed. In other words, two degree of 
freedom wheels can be mounted pointed upward on a stationary base, and can 
translate and rotate a horizontal surface resting on the wheels. In another possible 

20 application (not shown), multiple bases, each having single or multiple wheels, can be 
pivotably linked together in a snake-fashion to form a non-rigid base which is 
controlled by the inventive method. 

The above descriptions and drawings are for illustrative purposes only, and are 
not exhaustive of possible alternate embodiments of the invention. It is to be 

25 understood that the present invention is not limited to the sole embodiments described 
above and illustrated herein, but encompasses any and all variations falling within the 
scope of the appended claims. 
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What is claimed is: 



1 . A method of calculating a desired axis motion of a wheeled base from 
an overall desired motion of the wheeled base, the wheeled base having at least two 

5 wheels, each wheel having two axis which define two degrees of freedom for that 
wheel, each wheel having an attachment point on the base, the method comprising the 
steps of: 

receiving an inputted motion vector for an overall desired motion of 
the wheeled base; 

10 calculating from the inputted vector a desired two dimensional motion 

vector for each of the attachment points; 

mapping the motion vector of one of the attachment points to an axis 
motion for each of the two axes associated with the one attachment point, so 
that driving the two axes of the associated wheel will result in the desired base 
1 5 motion of the one attachment point; and 

repeating the previous step for each of the attachment points. 

2. A method of calculating a desired axis motion as recited in claim 1, 
wherein the step of calculating the two dimensional motion vector for each of the 

20 attachment points is characterized by the equations: 

y<mi ^yj+XwiWj 

wherein 

x mi is the desired wheel attachment point velocity in the x-direction of the base 
25 coordinates for each wheel i in meters per second, 

x d is the desired base velocity in the x-direction of the base coordinates in meters per 
second, 

y/ d is the desired rotational velocity in base coordinates in radians per second, 
y mi is the desired wheel attachment point velocity in the y direction of the base 
30 coordinates for each wheel i in meters per second, 
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y d is the desired base velocity in the x-direction of the base coordinates in meters per 
second, 

x Wi is the x-component of the wheel attachment point of wheel / in base coordinates 
in meters, and 

5 y m is the y-component of the wheel attachment point of wheel / in base coordinates 
in meters. 

3, A method of calculating a desired axis motion as recited in claim 1, 
wherein all of the wheels of the base have a caster that is equal to zero and the steps of 
mapping the motion vectors of the attachment points to axis motions is characterized 
10 by the equations : 

^=arctan2(^.,x^) 

MdWi ~~ V X dWi + y dWi 
S dWi ~ ^wfi dWi 
^ ~Wi 

t<JWi ~ MdWi 
r Wi 

1 5 wherein 

0 dWi is the desired steering angle for 2-DOF W z, in radians, 

y^ is the desired wheel attachment point velocity in the y direction of the base 

coordinates for each wheel / in meters per second, 
x mi is the desired wheel attachment point velocity in the x-direction of the base 
20 coordinates for each wheel / in meters per second, 

fi dm is the desired velocity magnitude for wheel i in meters per second, 

s mi is the desired steering angle with respect to base coordinates of wheel i in 

encoders, 

<j m is the steering axis "encoder pitch" for the steering axis of 2-DOFW / expressed in 
25 encoders per radian, 

t mi is the desired velocity of the translation axis for wheel / in encoders per second, 
t Wi is the translation axis "encoder pitch" for wheel i in encoders per radian, and 
r m is the wheel radius of wheel / in meters per radian. 
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4. A method of calculating a desired axis motion as recited in claim 1 , 
wherein all of the wheels of the base have a caster that is not equal to zero and the 
steps of mapping the motion vectors of the attachment points to axis motions is 
characterized by the equations: 

q — SmWi • 

U mWi ~ ' 

* s dwi = —{yawi c os(6 mm )~ x mi sm@ Mm ))-yr d ; and 

tar, = — (*dto cos (^) + y<mi *U!$ mm % 
wherein 

6 mWi is the measured angle of the steering axis of wheel i with respect to base 

coordinates in radians, 
s mWl is the measured angle of wheel i with respect to base coordinates in encoders, 
cr m is the steering axis "encoder pitch" for the steering axis of 2-DOFW-i expressed 

in encoders per radian, 
s mi is the desired steering axis velocity of wheel / in encoders per second, 
c Wi is the amount of caster offset in meters per radian, 

y mi is the desired wheel attachment point velocity in the y direction of the base 

coordinate for each wheel i in meters per second, 
x mi is the desired wheel attachment point velocity in the x-direction of the base 

coordinates for each wheel, i in meters per second, 
\j/ d is the desired base rotation velocity in radians per second, 

i mi is the desired velocity of the translation axis for wheel i in encoders per second, 
r m is the encoder pitch for 2DOFW i expressed in encoders per radians, and 
r Wi is the radius of the 2DOFW i in meters per radian. 

5. A method of providing a control envelope for axes on a wheeled base, 
the wheeled base having at least two wheels, each wheel having two axes which 
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define two degrees of freedom for that wheel, the control envelope ensuring that none 
of the wheel axes are commanded to move in a manner that they are not capable, the 
method comprising the steps of: 

defining for each of the axes of each of the wheels a maximum 

possible range of motion that will be permitted during an allotted control 

period; 

receiving an inputted motion vector for an overall desired motion of 
the wheeled base; 

calculating from the inputted vector a desired axis motion for each of 
the axes of each of the wheels, so that driving all of the axes will result in the 
overall desired motion of the base; 

determining if any of the desired axis motions are not within the 
permitted range of motion previously defined for that axis; and 

modifying as little as possible the overall desired motion of the base if 
required by the previous step such that all of the corresponding desired axis 
motions are within the permitted ranges of axis motion. 

6. A method of estimating rotation of a wheeled base relative to a surface 
during a discrete time interval At, the base having at least two wheels each pivotably 
and rotatably mounted thereon for contacting the surface and driving the base and 
surface relative to one another, the method comprising the steps of: 

calculating an apparent motion for each of the wheels during the time 
interval At; 

calculating a rotation of the base for each possible pair of the wheels 
based on the apparent motion calculated for each of the wheels; and 
averaging the results of the previous step. 

7. A method of estimating rotation of a wheeled base as recited in claim 
6, wherein the step of calculating an apparent motion of each wheel is represented by 
the equations: 

x' m = x Wi + At mm cos(0 mm ) - As mm sm(0 mWi ) ; and 
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wherein 

x' m is the x-component of the attachment point of wheel i after base motion during 

one control cycle in meters, 
x m is the x-component of the wheel attachment point of wheel i in base coordinates in 
5 meters, 

At mWj is the measured motion of the translation axis of wheel / during one control 

cycle expressed in meters, 
6 mWi is the measured angle of the steering axis of wheel / with respect to base 

coordinates in radians, 

10 As mWl is the measured motion of the steering axis of wheel / during one control cycle 
expressed in meters, 

y' m is the y-component of the attachment point of wheel i after base motion during 

one control cycle in meters, and 
y Wl is the y-component of the wheel attachment point of wheel i in base coordinates 
15 in meters. 

8. A method of estimating rotation of a wheeled base as recited in claim 
7, wherein each wheel has a steering axis and a rolling or translation axis, the two axis 
for each of the wheels being offset from one another such that the caster does not 

20 equal zero. 

9. A method of estimating rotation of a wheeled base as recited in claim 
7, wherein each wheel has a steering axis and a rolling or translation axis, the two axis 
for each of the wheels intersecting such that the caster equals zero. 

25 

10. A method of estimating rotation of a wheeled base as recited in claim 
6, wherein the steps of calculating a rotation of the base for each possible pair of the 
wheels and averaging the results are represented by the equation: 

^Ve ~ ~m Z arctan2 (y'wk -ywp x m -4 } )-arctan2 (y m -y Wj ,x m ~x Wj ), 
30 wherein 
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Ay/ e is the calculated rotation change in radians, 
m is the number of unique pair combinations of N wheels, 
j and k are index variables of a possible wheel pair combination, 
y r m is the y-component of the attachment point of wheel k after base motion during 
5 one control cycle in meters, 

y wj is the y-component of the attachment point of wheel j after base motion during 

one control cycle in meters, 
x r m is the x-component of the attachment point of wheel k after base motion during 
one control cycle in meters, 
10 x T Wj is the x-component of the attachment point of wheel j after base motion during 
one control cycle in meters, 
y m is the y-component of the wheel attachment point of wheel k in base coordinates 
in meters, 

y w is the y-component of the wheel attachment point of wheel j in base coordinates 
15 in meters, 

x m is the x-component of the wheel attachment point of wheel k in base coordinates 
in meters, and 

x Wj is the x-component of the wheel attachment point of wheel j in base coordinates in 
meters. 

20 

11. A method of calculating position and orientation of a wheeled base 
relative to a world coordinate system fixed to a surface, the base having a base 
coordinate system fixed thereto and at least two wheels each pivotably and rotatably 
mounted to the base at an attachment point for contacting the surface and driving the 
25 base and surface relative to one another, the method comprising the steps of: 
calculating a steering angle for each of the wheels; 
calculating a measured translation distance for each of the wheels 
traveled over a time At elapsed during a control cycle; 

calculating an apparent motion for each of the wheels based on the 
30 steering angle and measured translation calculated; 
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calculating an apparent position in base coordinates for each of the 
wheels by adding the calculated motion to the wheel attachment point at the 
beginning of the control cycle; 

calculating a rotation of the base for each possible pair of the wheels 
based on the apparent motion calculated for each of the wheels; 

calculating a total change in base rotation by averaging the results of 
the previous step; 

calculating a total change in translation coordinates by averaging the 
apparent motion of each of the wheels, taking into account the base rotation 
calculated in the previous step since the beginning of the control cycle; 

calculating a summed-up position and orientation of the mobile base in 
the fixed world coordinates by adding the total change in base angle to an 
existing angle estimate and adding the total change in translation coordinates 
to an existing estimate of translation coordinates. 

12. A method of calculating position and orientation of a wheeled base as 
recited in claim 1 1, wherein the step of calculating the total change in base rotation is 
characterized by the equation: 

^We ~ ~tf Z arctan2 (y'wk -y'wj> x m -^.)-arctan2(^ -y m ,x m -x^), 
wherein 

Ay/ e is the calculated rotation change in radians, 
m is the number of unique pair combinations of N wheels, 
j and k are index variables of a possible wheel pair combination, 
y' m is the y-component of the attachment point of wheel k after base motion during 

one control cycle in meters, 
y' Wj is the y-component of the attachment point of wheel j after base motion during 

one control cycle in meters, 
x f m is the x-component of the attachment point of wheel k after base motion during 

one control cycle in meters, 
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x' Wj is the x-component of the attachment point of wheel j after base motion during 

one control cycle in meters, 
y m is the y-component of the wheel attachment point of wheel k in base coordinates 

in meters, 

5 y Wj is the y-component of the wheel attachment point of wheel j in base coordinates 
in meters, 

x m is the x-component of the wheel attachment point of wheel k in base coordinated 
in meters, and 

x Wj is the x-component of the wheel attachment point of wheel j in base coordinated 
10 in meters. 

13. A method of calculating position and orientation of a wheeled base as 
recited in claim 11, wherein the step of calculating the total change in translation 
coordinates is characterized by the equations: 

N 

15 Ax e =iX(*i« + JV' A ^) 

7=1 

N 

7=1 

wherein 

Ax e is the estimated change of the base location in the x-direction in base coordinates 
since the previous control cycle in meters, 
20 N is the number of wheels, 
i is an index variable, 

x' m is the x-component of the attachment point of wheel i after base motion during 

one control cycle in meters, 
x m is the x-component of the wheel attachment point of wheel i in base coordinates 

25 in meters, 

y m is the y-component of the wheel attachment point of wheel i in base coordinate in 
meters, 
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Ay/ e is the estimated rotational change of the base location in base coordinates since 

the previous control cycle in meters, 
Ay e is the estimated change of the base location in the y-direction in base coordinates 

since the previous control cycle in meters, and 
y' Wl is the y-component of the attachment point of wheel i after base motion during 

one control cycle in meters. 

14. A method of calculating position and orientation of a wheeled base as 
recited in claim 1 1, wherein the step of calculating a summed-up position and 
orientation of the mobile base is characterized by the equations: 

x eB = x eB + Ax e cos(ys eB )- Ay e sin(^ e5 ) , and 
y& = yen + AVe cos<y e5 ) + Ax e $m(ys eB ) 
wherein 

y/ eB is the estimated rotational position of the base coordinate frame origin with 

respect to a fixed world coordinate frame, 
Ay/ e is the estimated rotational change of the base location in base coordinates since 

the previous control cycle in meters, 
x eB is the estimated position of the base coordinate frame origin in the x-direction of a 

fixed world coordinate frame, 
Ax e is the estimated change of the base location in the x-direction in base coordinates 

since the previous control cycle in meters, 
Ay e is the estimated change of the base location in the y-direction in base coordinates 

since the previous control cycle in meters, and 
y eB is the estimated position of the base coordinate frame origin in the y-direction of a 

fixed world coordinate frame. 

15. A method for controlling the motion of a wheeled base with respect to 
a surface, the base having a base coordinate system fixed thereto and at least two 
wheels each pivotably and rotatably mounted to the base at an attachment point for 

-27- 



contacting the surface and driving the base and surface relative to one another, each 
wheel having a plurality of axes, the method comprising the steps of: 
reading an input vector from a host processor; 

mapping the input vector to a desired axis motion vector for each of the 

5 axes; 

sending the desired axis motion vector to an axis controller for each of 
the axes; 

estimating a motion of the base traveled during a discrete time interval 

At; 

1 0 calculating a position and an orientation of the base in a set of world 

coordinates. 

16. A method for controlling the motion of a wheeled base as recited in 
claim 15, wherein the steps of estimating a motion of the base and calculating a 
1 5 position and orientation of the base further comprise the steps of: 
calculating a steering angle for each of the wheels; 
calculating a measured translation distance for each of the wheels 
traveled over a time At elapsed during a control cycle; 

calculating an apparent motion for each of the wheels based on the 
20 steering angle and measured translation calculated; 

calculating an apparent position in base coordinates for each of the 
wheels by adding the calculated motion to the wheel attachment point at the 
beginning of the control cycle 

calculating a rotation of the base for each possible pair of the wheels 
25 based on the apparent motion calculated for each of the wheels; 

calculating a total change in base rotation by averaging the results of 
the previous step; 

calculating a total change in translation coordinates by averaging the 
apparent motion of each of the wheels, taking into account the base rotation 
30 calculated in the previous step since the beginning of the control cycle; 

calculating a summed-up position and orientation of the mobile base in 
the fixed world coordinates by adding the total change in base angle to an 
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existing angle estimate and adding a rotated total change in translation 
coordinates to an existing estimate of translation coordinates. 

17. A method for controlling the motion of a wheeled base as recited in 
5 claim 16, wherein the step of calculating the total change in base rotation is 
characterized by the equation: 

arctan2 (y' m - y f Wj , x f m - x' m ) - arctan2 {y Wk - y WJ ,x m -x Wj ), 

wherein 

Ay e is the calculated rotation change in radians, 
10 m is the number of unique pair combinations of N wheels, 

j and k are index variables of a possible wheel pair combination, 
y f m is the y-component of the attachment point of wheel k after base motion during 

one control cycle in meters, 
y' Wj is the y-component of the attachment point of wheel j after base motion during 
1 5 one control cycle in meters, 

x f m is the x-component of the attachment point of wheel k after base motion during 

one control cycle in meters, 
x f Wj is the x-component of the attachment point of wheel j after base motion during 
one control cycle in meters, 
20 y m is the y-component of the wheel attachment point of wheel k in base coordinates 
in meters, 

y Wj is the y-component of the wheel attachment point of wheel j in base coordinates 
in meters, 

x m is the x-component of the wheel attachment point of wheel k in base coordinates 
25 in meters, and 

x Wj is the x-component of the wheel attachment point of wheel j in base coordinates in 
meters. 
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18. A method for controlling the motion of a wheeled base as recited in 
claim 16, wherein the step of calculating the total change in translation coordinates is 
characterized by the equations: 

N 

1=1 

N 

5 Ay. = jr^(y'm - x wAVe)> 

wherein 

Ax e is the estimated change of the base location in the x-direction in base coordinates 

since the previous control cycle in meters, 
N is the number of wheels, 
i is an index variable, 

x' m is the x-component of the attachment point of wheel / after base motion during 

one control cycle in meters, 
x Wl is the x-component of the wheel attachment point of wheel i in base coordinates 
in meters, 

y Wi is the y-component of the wheel attachment point of wheel i in base coordinate in 
meters, 

Ay/ e is the estimated rotational change of the base location in base coordinates since 

the previous control cycle in meters, 
Ay e is the estimated change of the base location in the y-direction in base coordinates 

since the previous control cycle in meters, and 
y' m is the y-component of the attachment point of wheel i after base motion during 
one control cycle in meters. 

25 19. A method for controlling the motion of a wheeled base as recited in 

claim 16, wherein the step of calculating a summed-up position and orientation of the 
mobile base is characterized by the equations: 

¥eB ^WeB+^Ve* 
X eB ~ X eB 

+ Ax e cosO eB ) - Ay e sin(^J , and 
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y eS = y eB + Ax* cos<y e j + A* e sin(^ efi ) 

wherein 

y/ eB is the estimated rotational position of the base coordinate frame origin with 

respect to a fixed world coordinate frame, 
5 Ayr, is the estimated rotational change of the base location in base coordinates since 

the previous control cycle in meters, 
x eB is the estimated position of the base coordinate frame origin in the x-direction of a 

fixed world coordinate frame, 
Ax e is the estimated change of the base location in the x-direction in base coordinates 
1 0 since the previous control cycle in meters, 

Ay e is the estimated change of the base location in the y-direction in base coordinates 

since the previous control cycle in meters, and 
y eB is the estimated position of the base coordinate frame origin in the y-direction of a 

fixed world coordinate frame. 

15 

20. A method for controlling the motion of a wheeled base with respect to 
a surface, the base having a base coordinate system fixed thereto and at least two 
wheels each pivotably and rotatably mounted to the base for contacting the surface 
and driving the base and surface relative to one another, each wheel having a plurality 
20 of axes, the method comprising the steps of: 

reading an input vector from a host processor; 

mapping the input vector to a desired axis motion vector for each of the 

axes; 

calculating a control envelope for each of the axes; 
25 determining whether the desired axis motion vector lies within the 

control envelope for each of the axes; 

calculating a modified axis motion vector for each of the axes in which 
the desired axis motion vector does not lie within the control envelope; 

sending the desired axis motion vector or modified axis motion vector 
30 to an axis controller for each of the axes; 
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estimating a motion of the base traveled during a discrete time interval 

At; 

calculating a position and an orientation of the base in a set of world 
coordinates; and 

5 repeating the previous steps continuously until commanded to stop. 

21 . A mobile base movable relative to a surface, the base comprising: 
at least two wheels pivotably and rotatably mounted to the base, each wheel 
having a steering axis and a rotation axis; 

10 drive means for rotating the wheels along the surface; 

steering means for pivoting the wheels with respect to the surface; and 
controller means for controlling the motion of the base, wherein the 
controller means includes means for reading an input vector from a host 
processor, mapping the input vector to a desired axis motion vector for each of 

15 the axes, calculating a control envelope for each of the axes, determining 

whether the axis motion vector lies within the control envelope for each of the 
axes, calculating a modified axis motion vector when the axis motion vector 
does not lie within the control envelope, sending the axis motion vector or 
modified axis motion vector to an axis controller for each of the axes, 

20 estimating a motion of the base traveled during a discrete time interval At, 

calculating a position and an orientation of the base in a set of world 
coordinates, and repeating the previous steps continuously until commanded to 
stop. 

25 22. A mobile base movable relative to a surface, the base 

comprising: 

at least three wheels pivotably and rotatably mounted to the base, each wheel 
having a steering axis and a rotation axis; 

drive means for rotating the wheels along the surface; 
30 first encoder means for sensing the rotation of each of the wheels and 

outputting a signal for each wheel in response thereto; 
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steering means for pivoting the wheels with respect to the surface; 

second encoder means for sensing the pivoting of each of the wheels 
and outputting a signal for each wheel in response thereto; and 

a processor for estimating a rotation of the base relative to the surface 
during a discrete time interval At by receiving the output signals from the first 
and second encoder means, calculating from the signals an apparent motion for 
each of the wheels during the time interval At, calculating from the apparent 
motions a rotation of the base during the time interval At for each possible pair 
of wheels, and averaging the results of the calculated rotations. 

23. A mobile base movable relative to a surface, the base 

comprising: 

at least two wheels pivotably and rotatably mounted to the base, each wheel 
having a steering axis and a rotation axis; 

drive means for rotating the wheels along the surface; 
steering means for pivoting the wheels with respect to the surface; 
a controller for supplying power to the drive means and the steering 
means; and 

a processor for sending command signals to the controller and for 
calculating a control envelope to ensure that commands are not sent to the 
controller that cannot be executed by the drive means or the steering means, 
the processor calculating the control envelope by receiving an input motion 
signal indicating an overall desired motion of the base, calculating from the 
input signal a desired axis motion for each of the wheel axes that will achieve 
the overall desired motion of the base, determining if each of the desired axis 
motions is within an associated range of motion predefined for each of the 
axes, and, if required, modifying as little as possible the overall desired motion 
of the base until all of the corresponding desired axis motions are within the 
associated predefined ranges of axis motion. 

24. A method of providing a control envelope for axes on a wheeled base, 

the wheeled base having at least two wheels, each wheel having two axes which 
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define two degrees of freedom for that wheel, the control envelope ensuring that none 
of the wheel axes are commanded to move in a manner that they are not capable, the 
method comprising the steps of: 

defining for each of the axes of each of the wheels a maximum permitted 
5 range of torque; 

receiving an inputted force vector for an overall desired resultant force of the 
wheeled base; 

calculating from the inputted vector a desired axis torque for each of the axes 
of each of the wheels, so that driving all of the axes will result in the overall desired 
1 0 force of the base; 

determining if any of the desired axis torques are not within the permitted 
range of torque previously defined for that axis; and 

modifying as little as possible the overall desired force input vector of the base 
if required by the previous step such that all of the corresponding desired axis torques 
15 are within the permitted ranges of axis torques. 

25. A method of calculating position and orientation of a wheeled base as 
recited in claim 1 1, wherein the steps of calculating the total change in rotation and 
translation coordinates are characterized by the equation: 

20 ^ = A? C x [&S m w\ ? ^mW\ •> ' ' • y ^mWi ' ^mWi ^ mWN ? ^ mWN ] 



wherein 



m 



is the estimated mobile base motion in base coordinates. 



25 



&t is the time elapsed during a control cycle (s), 

C # 

x is the velocity estimation matrix, a generalized left inverse of the 



constraint matrix, 



is the measured motion of the steering axis of wheel i during one 



control cycle, 



m is the measured motion of the translation axis of wheel i during one 



30 



control cycle, and 
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N is the number of wheels mounted to the base. 



26. A mobile base movable relative to a surface, the base comprising: 
a main housing; 

5 at least two wheels pivotably and rotatably mounted to the housing , each 

wheel having a steering axis and a rotation axis with the steering and rotation axes 
nonintersecting and offset by a known caster distance; 

drive means for rotating the wheels to roll along the surface; 
steering means for pivoting the wheels and changing their heading with 
10 respect to the surface; and 
controller means for 

reading an input vector from a host processor, wherein the input vector is a 
three dimensional force torque vector, 

reading the steering axis headings, 
15 calculating a desired torque for each steering and rotation axis such that at any 

given time, the calculated resultant forces on the base reflect the input vector, 
regardless of the positions of the steering and rotation axes, and 

commanding the calculated torque to each steering and rotation axis. 

20 

27. An apparatus as described in claim 26 wherein the controller means 
includes a dynamic model such that the controller means compensates for undesired 
motion of the base due to various motions of the wheels. 

25 28. An apparatus as described in claim 26 wherein the calculated torque of 

each steering and rotation axis is computed from the input vector and a generalized 

inverse of a constraint matrix, C ? the constraint matrix being defined by the following 
kinematic relationship: 

m a = Cm x 

30 where m<l represents a motion axis vector and ^represents actual mobile 

base motion. 
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29. An apparatus as described in claim 28 wherein the generalized inverse 

of C is chosen such that a sum of squares of the axis torques is minimized. 

30. An apparatus as described in claim 28 wherein the generalized inverse 

of C is chosen such that a sum of squares of wheel contact forces is minimized. 

3 1 . An apparatus as described in claim 28 wherein there is an 
instantaneous power for each of the steering and rotation axes and wherein the 

generalized inverse of C is chosen such that a sum of the instantaneous powers of all 
of the axes is minimized. 
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Abstract of the Disclosure 

A mobile robot base movable relative to a surface, comprising: at least two 
wheels pivotably and rotatably mounted to the base, each wheel having a steering axis 
and a rotation axis; drive means for rotating the wheels along the surface; steering 
5 means for pivoting the wheels with respect to the surface; and controller means for 
controlling the motion of the base, wherein the controller means includes means for 
reading an input motion vector from a host processor, mapping the input vector to a 
desired axis motion vector for each of the axes (Fig. 3), calculating a control envelope 
for each of the axes, determining whether the axis motion vector lies within the 

10 control envelope for each of the axes (Fig. 3), calculating a modified axis motion 
vector when the axis motion vector does not lie within the control envelope (Fig. 3), 
sending the axis motion vector or modified axis motion vector to an axis controller for 
each of the axes (Fig. 3), estimating a motion of the base traveled during a discrete 
time interval delta t (Fig. 3), calculating a position and an orientation of the base in a 

15 set of world coordinates (Fig. 3), and repeating the previous steps continuously until 
commanded to stop (Fig. 3). Other aspects include a holonomic base capable of 
instantaneous movement in any direction without reconfiguring the wheel headings, 
regardless of the configuration of the wheels. Also, a method of using forces and 
torques to control the base, and to compensate for undesired motions of the base due 

20 to dynamic effects of the wheel motions is disclosed. 
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